# 串口控制机械臂
from serial import Serial

with Serial("COM5", 74880, timeout = 2) as s:
    # 发送G代码指令到机械臂
    s.write(b'G00 X100 Y100 Z0\n')
    # 从串口读取指令执行结果，超时时间2秒
    # 检查返回结果的最后一行，如果是OK，说明执行成功
    print(s.readlines()[-1].decode())
    s.write(b'G00 X0 Y100 Z50\n')
    status = s.readlines()[-1].decode()
    if status == "OK\r\n":
        print("指令执行成功")
    
    # 关闭串口
    s.close()
